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ARTICLE  INFO  ABSTRACT 

An  adaptive  predictor-corrector  reentry  guidance  algorithm  with  self-defined  way-points  is  proposed. 
In  the  guidance  process,  the  reentry  trajectory  is  divided  into  the  predictor-corrector  phase  and  the 
trajectory  onboard  generation  and  tracking  phase  which  is  near  to  the  endpoint  position  of  reentry  and 
utilized  to  improve  the  accuracy  and  adaptivity  of  the  guidance.  In  the  first  phase,  the  predictor-corrector 
algorithm  is  applied  to  solve  the  guidance  problem  between  the  self-defined  way-points.  Moreover  the 
position  parameters  of  reentry  trajectory  are  translated  into  the  parameters  related  to  the  reentry  plane 
by  orthogonal  transformation  in  the  spherical  coordinate  to  improve  robustness  of  guidance  algorithm. 
In  addition,  the  predictor-corrector  algorithm  is  implemented  using  a  brain  emotional  learning  based 
intelligence  controller  (BELBIC).  In  the  second  phase,  the  trajectory  from  the  current  point  to  the  endpoint 
is  generated  onboard  and  the  linear-quadratic  regulator  (LQR)  theory  is  employed  for  trajectory  tracking. 
The  effectivity  of  the  proposed  guidance  is  validated  by  simulations  in  conditions  of  the  nominal  case, 
the  environment  dispersed  case  and  the  endpoint  maneuvering  case.  The  advantages  of  this  guidance 
in  coping  with  disturbances,  reducing  time  of  numerical  trajectory  prediction  and  being  suitable  for 
maneuver  endpoint  are  analyzed  with  the  simulation  results. 
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1.  Introduction 

Various  hypersonic  and  reentry  vehicle  technologies  are  being 
pursued  to  enable  a  prompt  global  reach  ability,  such  as  the  Fal¬ 
con  plan  vehicle  of  U.S.  Air  Force,  e.g.,  the  Common  Aero  Vehicle. 
The  reentry  guidance  plays  an  important  role  in  steering  the  vehi¬ 
cle  safely  through  the  dispersed  reentry  flight  environment,  while 
meeting  the  mission  requirements  [7],  A  high  degree  of  autonomy 
and  adaptability  is  desirable  for  future  reentry  vehicles. 

Much  of  the  reentry  guidance  techniques  in  development  to¬ 
day  are  influenced  by  the  Space  Shuttle  reentry  guidance.  This 
guidance  and  other  similar  acceleration  guidances,  like  drag  ac¬ 
celeration  planning  and  tracking  guidance,  are  almost  based  on 
the  assumption  that  the  vehicle  will  follow  a  great  circle  arc  con¬ 
necting  the  initial  entry  point  to  the  target  point.  So  the  accuracy 
of  this  kind  of  guidance  is  reduced  at  high  crossrange  [4,9,10,14, 
19].  The  Evolved  Acceleration  Guidance  Logic  for  Entry  (EAGLE)  is 
originally  presented  by  Saraf  et  al.  [15].  It  is  a  direct  extension  of 
the  Shuttle’s  longitudinal  acceleration  guidance  to  include  the  lat¬ 
eral  dimension.  Leavitt  improves  the  EAGLE  for  its  application  in 
suborbital  entry  scenario  [8],  The  reference  heading  angle  is  also 
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tracked  with  bank  angle  as  the  control  variable.  However,  man¬ 
ual  tuning  of  the  trajectory  tracking  law  is  needed  in  EAGLE.  It 
is  expected  that  the  need  for  manual  tuning  could  eventually  be 
eliminated. 

Other  researchers  break  away  from  the  traditional  drag  guid¬ 
ance  approach.  Dukeman  has  developed  a  linear  state-feedback 
longitudinal  tracking  law  [3],  The  energy-varying  gains  are  tuned 
offline  using  an  LQR.  Strength  of  the  tracking  law  is  the  near  tra¬ 
jectory  independence  of  its  gain  tuning.  Zimmerman  et  al.  have 
developed  an  onboard  trajectory  planner  [27],  Trajectory  design  is 
implemented  in  two  parts.  In  the  earlier  part,  a  constant  thermal 
flux  is  followed.  In  the  second  part,  the  planner  designs  a  linear 
bank  angle  profile  with  bank  reversals  to  meet  the  final  range, 
heading,  and  altitude  requirements.  Shen  and  Lu  also  plan  and 
track  complete  three-degree-of-freedom  entry  trajectories  [16,17], 
The  planning  occurs  onboard  before  entry.  During  trajectory  de¬ 
sign,  the  entry  phase  is  broken  into  three  sub-phases,  the  most  sig¬ 
nificant  of  which  is  the  quasi-equilibrium  glide  (QEG)  phase.  Then 
the  authors  have  developed  a  trajectory  planner  for  suborbital  en¬ 
try  which  does  not  use  the  QEG  assumption  [18],  During  entry 
phase,  the  planned  longitude  dynamics  are  followed  by  tracking 
law  which  is  similar  to  Dukeman’s  guidance.  The  bank  reversals 
are  commanded  using  the  logic  similar  to  the  Shuttle’s,  though  the 
crossrange  is  used  as  a  reversal  criterion  instead  of  heading  angle. 
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Due  to  the  enhancement  of  the  capability  of  the  computer,  the 
numerical  predictor-corrector  guidance  is  developed  in  the  past 
few  decades.  Youssef  designs  a  predictor-corrector  guidance  to 
handle  widely  dispersed  entry  conditions  [26],  The  control  vari¬ 
ables  are  perturbations  of  the  bank  angle,  the  angle-of-attack  and 
the  time  for  roll  reversal.  The  bank  angle  and  the  angle-of-attack 
profiles  are  the  nominal  profiles  plus  the  perturbations.  The  alti¬ 
tude,  heading  and  range  errors  at  terminal  area  energy  manage¬ 
ment  interface  are  used  to  correct  the  initial  guess  of  the  control 
variables.  Several  perturbed  state  cases  for  initial  entry  conditions 
and  different  initial  guesses  are  used  to  test  the  performance  of  the 
guidance  for  the  X-33  operations.  However,  the  real-time  applica¬ 
tion  of  the  algorithm  needs  further  demonstration.  A  predictor- 
corrector  guidance  algorithm  for  atmospheric  reentry  is  presented 
by  Joshi  et  al.  [7],  The  control  variables  are  parameterized  with 
variation  over  nominal  angle-of-attack  (AOA)  profile  and  a  bank 
angle  at  a  predefined  velocity  for  constructing  linear  variation  of 
the  bank  angle  with  respect  to  relative  velocity.  Otherwise  the 
guidance  methodology  includes  the  path  constraint  control  law  as 
a  part  of  the  predictor  algorithm,  namely  the  bank  angle  is  modu¬ 
lated  when  the  drag  and  drag  rate  of  predict  trajectory  exceed  the 
boundaries  decided  by  path  constraints.  Xue  also  develops  a  con¬ 
strained  predictor-corrector  entry  guidance  algorithm  for  vehicles 
with  medium  to  higher  lifting  capability  [22],  The  algorithm  en¬ 
forces  the  path  constraints  by  transforming  them  into  the  energy- 
dependent  upper  and  lower  bounds  in  the  velocity-altitude  space 
with  the  help  of  quasi-equilibrium  glide  condition  (QEGC)  for  the 
magnitude  of  the  bank  angle.  In  addition,  the  numerical  predictor- 
corrector  is  used  as  the  core  algorithm  in  newly  developed  entry 
guidance  for  the  lifting  interplanetary  re-entry  vehicle  and  the  cap¬ 
sule  return  from  the  Moon  [1,2,20], 

In  this  paper,  an  adaptive  predictor-corrector  reentry  guidance 
based  on  self-definition  way-points  is  proposed  for  the  medium  to 
high  lift-to-drag  ratio  reentry  vehicles.  The  strategy  of  the  guid¬ 
ance  is  purposed  to  improve  its  performance  in  crossrange  control, 
adaptivity  to  disturbed  circumstances  and  dealing  with  maneuver- 
able  target. 

2.  Outline  of  the  presented  guidance  strategy 

The  presented  reentry  guidance  is  divided  into  two  phases  from 
the  initial  point  to  the  endpoint  of  reentry,  as  described  in  Fig.  1. 
In  the  first  phase  (PI),  the  predictor-corrector  guidance  between 
self-defined  way-points  is  implemented.  In  the  second  phase  (PI1), 
which  is  near  the  endpoint,  an  onboard  trajectory  generation  and 
tracking  guidance  is  adopted  to  enhance  the  adaptability  of  the 
guidance.  Furthermore,  the  key  points  of  the  guidance  strategy  are 
as  following: 

A.  In  the  predictor-corrector  phase,  the  normal  sphere  coordi¬ 
nate  system  is  translated  to  a  new  sphere  coordinate  system  by 
orthogonal  transformation,  in  which  the  plane  of  zero  latitude  is 
coincidence  to  the  reentry  plane. 

B.  The  way-points  are  defined  in  the  new  sphere  coordinate 
and  generated  by  the  optimal  trajectory  which  is  obtained  by 
Gauss  pseudospectral  method.  In  addition,  the  way-points  are  cor¬ 
responding  to  the  Gauss  nodes  of  the  optimal  trajectory. 

C.  The  predictor-corrector  algorithm,  which  is  implemented  be¬ 
tween  the  self-defined  way-points,  is  developed  by  the  Brain  Emo¬ 
tional  Learning  Based  Intelligence  Controller  for  its  robustness  and 
less  computation  time. 

D.  In  the  second  guidance  phase,  a  three  dimensional  reference 
trajectory,  from  the  current  position  to  the  endpoint,  is  generated 
onboard.  And  the  linear-quadratic  regulator  is  employed  for  trajec¬ 
tory  tracking. 


PI:  Predictor-corrector  Phase 

PII:  Trajectory  generation  and  tracking  phase 

Fig.  1.  Sketch  map  of  the  presented  guidance. 

3.  Coordinate  transformation  and  way-points  determination 

3.1.  Coordinate  transformation  for  guidance 

In  normal  sphere  coordinate  system,  supposing  a  rotational 
sphere  earth  model,  we  use  the  radial  distance  from  the  center 
of  the  earth,  longitude  and  latitude  to  describe  the  position  of  the 
vehicle  relative  to  the  Earth.  And  we  also  use  the  magnitude  of 
velocity,  flight  path  angle  and  azimuth  angel  to  describe  the  ve¬ 
hicle  velocity  relative  to  the  Earth  [21],  Here,  the  motivation  is  to 
present  a  new  sphere  coordinate  to  denote  the  position  and  ve¬ 
locity  of  the  vehicle  relative  to  reentry  plane  through  orthogonal 
transformation.  The  new  sphere  coordinate  is  obtained  as  the  fol¬ 
lowing  steps. 

3.1.1.  Orthogonal  rotation  of  sphere  coordinate  system 

Firstly  the  reference  plane  can  be  determined  by  the  two  vec¬ 
tors:  one  is  from  the  center  of  the  Earth  to  the  reentry  point, 
another  is  from  center  of  the  Earth  (the  same  start  point)  to  the 
endpoint  of  reentry.  Then  the  sphere  coordinate  system  is  rotated 
to  let  the  zero  latitude  plane  (so  called  the  equatorial  plane)  be 
coincidence  to  the  reentry  plane.  In  the  new  sphere  coordinate 
system,  we  use  9,<p,r,  V,  y,  to  denote  the  reentry  states.  Ac¬ 
cording  to  the  definition  of  reentry  plane,  the  new  longitude  9 
and  the  new  latitude  <p  can  directly  indicate  the  downrange  and 
crossrange  of  the  reentry  vehicle  respectively.  And  it  is  obviously 
that  r  =  r,V  =  V,y=y.  In  addition,  to  establish  the  dimension¬ 
less  equations  of  motion  for  guidance  the  r  is  normalized  by  the 
average  radius  of  the  Earth  R o  =  6378  km  and  denoted  as  z.  And 
the  Earth  relative  velocity  V  is  normalized  by  Vc  —  ^/goRo,  where 
go  =  9.81  m/s2  and  denoted  as  u.  So  in  dimensionless  formulation, 
we  have 


Y  =  Y 


(1) 


3.1.2.  Coordinate  transformation 

In  order  to  establish  the  relationship  between  the  normal 
sphere  coordinate  system  and  the  transformed  one,  three  rectangu¬ 
lar  coordinate  systems,  diagrammed  in  Fig.  2,  are  introduced  here. 
Two  of  them  are  the  Earth  frame  0-XeYeZe  and  rotated  Earth 
frame  O-XeYeZe.  The  plane  XeOYe  is  the  equatorial  plane  and 
the  plane  XeOYe  is  the  reference  reentry  plane.  So  we  have  the 
relationship 


If  rcoscpcos9  ~| 
=  rC0S^  • 
L  rsin9J  J 
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Next  a  reentry  coordinate  system  oe-xyz  is  introduced  and  de¬ 
fined  as:  1)  the  origin  of  the  coordinate  is  the  reentry  point;  2)  the 
oex-axis  is  in  the  local  horizon  plane  of  the  point  oe  and  points  to 
the  endpoint:  3)  the  oey-axis  is  perpendicular  to  the  local  horizon 
plane  and  points  to  upward  direction;  4)  the  oez-axis  completes  a 
right-handed  rectangular  coordinate  system. 

The  transition  matrix,  from  the  Earth  frame  O-XeYeZe  to  the 
reentry  frame  oe-xyz  is  [5] 

Ge  =  M2[-(A0  +  90°)]JWi[^o]M3[(^o  -  90°)]  (3) 

Where  A0  is  the  deviation  angle  of  reentry  plane  from  the  north 
direction  and  M,-  [A]  denotes  the  coordinate  transition  element  Eu¬ 
ler  matrix  which  is  relative  to  a  coordinate  rotating  along  the  i-th 
axis  with  the  X  angle.  The  azimuth  angle  Aq  can  be  calculated  as 

!arcsin( cos s^* e°r ) ,  sin^r  -  cos/6  sin^o  >  0 

sign{arcsin(C0syiT  s^Bm)}n  -  arcsin(c°s^1'  s~  e°T ),  (4) 

simpj  —  cos /I  sin#>o  <  0 

Where 

\0ot=0t-Q0 

1  P  =  arccos  (sin  <jp0  sin  +  cos  ipo  cos  ipr  cos  0or ) 

In  Eqs.  (3)-(4),  the  subscripts  0  and  T  denote  the  reentry  point 
states  and  the  endpoint  states  respectively. 

It  is  convenient  to  translate  the  base  Oe  to  the  base  O  to  estab¬ 
lish  the  transition  matrix  from  frame  oe-xyz  to  frame  0-XeYeZe 
(also  see  Fig.  2),  that  is 

G-=M3[-90o]M1[-180°]  (5) 

Hence  we  have  the  transformation  matrix  equation  from  the 
coordinate  0-XeYeZe  to  the  coordinate  0-XEYEZE.  Furthermore, 
the  relationship  between  the  normal  sphere  coordinate  system  and 
the  transformed  one  can  be  derived,  as  described  in  Fig.  3.  So  we 
have 


rcoscpcosO  1 

=  G  rcos^sin#  (6) 

L  rsin^  J 

Where 

COS(00COS80  cosy>osin0o  sinqjg  1 

-sinAosin0o  -  cos  A0  siny>0  cos0o  sinAgcosSg -cosAosin(0Osin0g  cosAgcospg 
cos Ag sinSg  —  sinAg sin^jg cos(?g  -cosAgcosflg -  sinAg  sinyigsinSg  sinAgcosyig  J 

In  addition,  the  velocity  azimuth  angle  i \r  is  defined  as  the  an¬ 
gle  between  velocity  vector  and  the  reentry  plane,  that  is 

ir  =  ir-A0  (7) 

So  with  Eq.  (1),  Eq.  (6)  and  Eq.  (7)  the  dimensionless  kinemat- 
ical  equation  of  motion  in  transformed  sphere  coordinate  can  be 
achieved,  see  Eq.  (A.5).  The  details  are  described  in  Appendix  A. 

3.2.  Way-points  determination  in  the  transformed  sphere  coordinate 
system 

Before  in  the  above  work  we  design  an  optimal  trajectory  via  a 
Gauss  pseudospectral  method  (GPM)  in  normal  sphere  coordinate 
system.  The  method  is  proposed  by  Yong  et  al.  [25],  Then  a  tra¬ 
jectory  in  transferred  coordinate  system  can  be  obtained  through 
submitting  the  control  variable  a(z),  <t(t)  into  equations  of  mo¬ 
tion  (A.5)  simultaneously  let  do  —  0°,(po  =  0°.  And  other  initial 
parameters  can  be  determined  by  Eqs.  (1)  and  (7). 

Then  the  trajectory  states  for  guidance  application  correspond¬ 
ing  to  the  Gauss  node  can  be  saved  as  way-points,  including  lon¬ 
gitude,  latitude,  dimensionless  velocity,  dimensionless  radial  dis¬ 
tance  and  bank  angle,  signed  as  (6‘Ref,  5j,e/,?te/,  a^f).  In  Fig.  4, 

simulation  results  provide  the  comparison  of  trajectory  and  way- 
points  before  and  after  coordinate  transformation.  It  indicates  that 
the  position  states  are  transitioned  to  reentry  plane  relative  ones. 
And  it’s  helpful  to  adaptivity  of  the  guidance  algorithm. 

4.  Predictor-corrector  algorithm  between  way-points 

4.1.  Description  of  guidance  problem  between  way-points 

The  guidance  algorithm  in  phase  I  is  implemented  not  between 
initial  point  and  endpoint,  like  the  ordinary  predictor-corrector 
guidance,  but  between  adjacent  way-points. 

The  dimensionless  energy  of  the  i-th  way-point  is  defined  as 

ef  =  “Re/2/2  “  ^ 


Please  cite  this  article  in  press  as:  E.-m.  Yong  et  al.,  An  adaptive  predictor-corrector  reentry  guidance  based  on  self-definition  way-points,  Aerosp.  Sci.  Technol.  (2014), 
http://dx.doi.Org/10.1016/j.ast2014.08.004 


ARTICLE  IN  PRESS 


JID:AESCTE  AID:3109/FLA 


[m5G;  v  1.134;  Prn:28/08/2014;  14:08]  P.4(1-11) 


E.-m.  Yong  et  al.  /  Aerospace  Science  and  Technology  •••(••••_)•• 


Longitude/deg  Longitude(transformed)/deg 

Fig.  4.  Comparison  of  trajectory  and  way-points  before  and  after  transformation. 


Fig.  5.  AOA  profile. 
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a.  |aj  in  initial  descent  b.  |oj  after  the  2nd  way-point 

Fig.  6.  Bank  angle  magnitude  profile  between  way-points. 

The  guidance  problem  between  way-points  can  be  described 
as:  using  the  states  of  the  z'-th  way-point  xl  =  (z\  0l,  <p\  u\  y‘,  fl) 
as  the  initial  condition  to  calculate  the  bank  angle  cr(u)  and  the 
angle-of-attack  a  (a)  so  that  the  trajectory  can  satisfy  the  position 
constraints  of  the  next  way-point 

(9) 

55  when  e  =  ej.^1  and  the  path  constraints  of  heat  rate,  dynamic  pres- 

56  sure  and  aerodynamic  load  factor. 

57 

58  4.2.  Modeling  of  control  parameters 

60  To  obtain  the  trajectory  control  variables,  a(u)  and  cr(u)  should 

61  be  parameterized. 

62 

63  4.2.1.  Parameterized  model  of  angle-of-attack 

54  The  normal  profile  of  AOA  is  designed  as  the  linear  function  of 

65  dimensionless  velocity.  Here,  ctm,oiN2,Ui  and  u 2  are  predefined 

66  values  [23],  With  the  control  parameter  Aa,  the  instantaneous 


Fig.  7.  Crossrange  boundary  for  bank  reverse  logic. 

value  of  a  can  be  determined  by  normal  profile  and  Aa,  showed 
in  Fig.  5.  It  is  used  in  trajectory  propagation  of  the  predictor  in  the 
whole  reentry  duration. 

4.2.2.  Parameterized  model  of  bank  angle 

The  model  of  the  magnitude  of  bank  angle  |oj  is  given  in 
Eq.  (10)  and  the  corresponding  Fig.  6,  where  ej^  and  uj£!  are 
the  i-th  predefined  dimensionless  energy  and  velocity  of  the  way- 
points,  and  |<r'|  is  the  magnitude  of  bank  angle  of  the  i-th  way- 
point  to  be  solved.  In  the  first  part,  the  initial  descent  phase  of 
reentry,  we  use  a  constant  magnitude  of  bank  angle  |cr 1 1  to  modu¬ 
late  trajectories  [16],  Thus  a  linear  model  of  bank  angle  magnitude 
between  way-points  is  adopted  in  the  rest  of  predictor-corrector 
phase,  which  is  a  quasi-equilibrium  glide  phase. 

|<T(U)| 


lor'"8*!#  azjpr  (l°r' 


e  -  v 


(10) 

Bank  reversal  logic  is  employed  to  determine  the  sign  of  a  for 
trajectory  prediction.  In  transformed  sphere  coordinate,  the  new 
latitude  <p  stands  for  the  crossrange  and  is  directly  utilized  to 
construct  the  boundary  function  of  bank  reversal,  as  described  in 
Eq.  (11)  and  Fig.  7.  The  numerical  simulation  indicates  that  the 
bank  reversal  logic  is  not  very  sensitive  to  the  boundary.  Hence 
these  parameters  <p\,  <p2,  U3,  U4,  u5  are  predetermined  in  this 

guidance. 


<Pi 

3x1  =  I 

l  y?2  +  (u  -  U4)(^3  -  <p2 )/(U5  -  U4) 


l  >  U3 
(4  <  a  <  U3 


1„  An  adaptive  predictor-corrector  reentry  guidance  b; 


in  self-definition  way-points,  Aerosp.  Sci.  Technol.  (2014), 
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Fig.  8.  Architecture  of  BEL  controller  [11], 


With  summarizing  the  above  models  we  know  that  the  con¬ 
trol  parameters  for  the  predictor-corrector  reentry  guidance  are 
Aa,  | cr 1 1  and  |erl+1|  (i  =  1,2,  ■  ■  -Npt),  where  Npt  is  the  number  of 
way-points. 

4.3.  Predictor-corrector  algorithm  based  on  BELBIC 

The  general  numerical  predictor-corrector  algorithm  based  on 
Newton  iteration  method,  which  is  very  sensitive  to  the  initial 
value,  is  difficult  to  implement  in  real  time  on  the  computer  of 
reentry  vehicles  at  present.  In  this  research,  an  intelligence  con¬ 
troller,  BELBIC,  is  used  to  develop  a  high  performance  predictor- 
corrector  algorithm.  Due  to  the  learning  ability  of  BELBIC,  it  is  very 
powerful  in  stabilizing  and  fast  in  converging  to  an  appropriate 
control  signal.  In  addition  the  iteration  is  not  needed  in  BELBIC. 
The  applications  show  very  good  adaptability  and  robustness  of 
the  intelligence  controller.  It  is  also  proven  to  be  very  effective 
controller  with  less  computation  time. 

4.3.1.  Introduction  of  BELBIC 

Recently,  a  computational  model  of  emotional  learning  in  mam¬ 
malians  brain  has  been  proposed  by  Moren  and  Balkenius  [12,13], 
Using  proposed  model  a  control  algorithm  has  been  introduced, 
which  is  called  BELBIC,  and  has  been  successfully  employed  in 
design  making  and  control  for  simple  linear  systems  as  well  as 
nonlinear  systems.  The  applications  show  very  good  adaptability 
and  robustness  of  the  intelligence  controller.  The  detail  of  BELBIC 
computational  model  can  be  found  in  [11], 

4.3.2.  The  controller  for  predictor-corrector 

4.3.2.I.  Architecture  of  BEL  controller  Inputs  to  emotional  learning 
mechanism  are  a  set  of  sensory  input  signals  as  well  as  a  reinforc¬ 
ing  signal.  These  signals  generally  can  be  arbitrarily  selected  by  the 
designer  of  the  control  algorithm.  It  is  recommended  that  the  rein¬ 
forcing  signal  REW  is  a  function  of  the  other  signals  which  can  be 
supposed  as  a  cost  function  rationale,  specifically  award  and  pun¬ 
ishment 

REW  =  f\(e,  uBel)  (12) 

Where  e(e  =  yr  —  yp)  is  the  error  signal  and  Ubel  is  the  control 
output.  yr  and  yp  are  the  reference  output  and  the  plant  output 
respectively. 

Similarly  the  sensory  inputs  must  be  a  function  of  plant  out¬ 
puts,  reference  outputs  and  controller  outputs  are  as  follows 

Si  =  f2(yP,yr,UBEL)  (13) 

The  architecture  of  BEL  controller  is  shown  in  Fig.  8.  As  illus¬ 
trated  in  [11],  sensory  input  and  reward  signal  are  inputs  of  intel¬ 
ligence  controller  and  can  be  an  arbitrary  function  of  yr,yp,UBEL 
and  e.  It  is  all  up  to  the  designer  to  find  a  proper  function  for  con¬ 
trol. 
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Table  1 

Inputs  of  the  intelligence  controllers. 


Controller 

Design 

variable 

REW 

Sensory  inputs  Si 

BEL1 

ka\80i+i  -f  ka25ui+1 

Aa) 

BEL2 

Acri+1 

ka\8(pi+1  +k<r2<5ui+1 

4.3.22.  BELBIC  for  predictor-corrector  guidance  The  BELBIC  is  re¬ 
quired  to  amend  the  control  variables  according  to  system  outputs 
to  approach  reference  outputs  whereas  the  initial  value  of  control 
variable  is  not  given  in  the  controller.  So  it  is  recommended  that 
using  increment  of  the  control  variable  as  the  design  variable  of 
BIEBIC.  Thus  we  decompose  the  bank  angle  into  two  parts:  the 
reference  value,  which  comes  from  the  predetermined  optimal  tra¬ 
jectory  in  the  way-points,  and  the  incremental  value,  that  is  to  say 
|or'+1|  =fre/1l  J  Affi+1,  where  [rr1^1 1  is  the  predetermined  |cr  | 
at  every  way-point.  And  the  sign  of  the  bank  angle  is  still  decided 
by  bank  reversal  logic.  Then  we  design  two  intelligence  controllers, 
denoted  as  BEL1  and  BEL2,  to  calculate  the  guidance  variables  Aa 
and  Aerl+1.  The  REW  and  sensory  inputs  of  the  two  controllers  are 
listed  in  Table  1.  The  errors  of  the  downrange  and  the  crossrange 
are  reflected  in  REW.  And  the  sensory  inputs  are  functions  of  the 
target  position,  the  prediction  position  and  the  controller  outputs 
as  follows: 

ft  i  Sal  =  kaAt/ ;  Sa2  =  kaAA !  Sa2  =  k„5  Act 
f2  :  So-i  =  k^tp'+j  ;  Sa2  =  k„4(plp+^ i  Sa3  =  ka5  A ct,+1 

(14) 

In  one  guidance  circle,  the  inputs  of  intelligence  controllers 
(BEL1,  BEL2)  can  be  obtained  by  trajectory  predicting,  which  im¬ 
plements  numerical  integration  once  from  the  current  state  to  the 
next  way-point  state.  The  outputs  of  the  controllers  consequently 
become  the  control  variables  of  the  predictor-corrector  guidance. 

4.4.  Path  constraints  implementation  in  predictor-corrector  algorithm 

The  feasible  region  of  reentry  trajectories  is  specified  by  path 
constraints  of  heating  rate,  aerodynamic  load,  dynamic  pressure 
and  QEG.  To  ensure  the  guided  trajectory  to  satisfy  these  con¬ 
straints,  these  requirements  are  converted  to  the  constraint  of  bank 
angle  and  implemented  in  trajectory  predictor.  This  work  is  com¬ 
pleted  by  Yong  et  al.  [24]  and  will  not  list  here  for  the  length 
limitation. 

5.  Trajectory  generation  and  tracking  in  PII 

The  former  works  are  all  for  the  first  phase  guidance.  To  en¬ 
hance  the  adaptability  of  the  guidance  algorithm,  we  propose  an 
onboard  trajectory  generation  and  tracking  algorithm  in  the  second 
phase  (PII)  which  is  close  to  the  endpoint.  The  triggering  condition 
of  the  phase  II  is 

Stogo  5:  Seen  (15) 

where  Stogo  is  the  rang-to-go  of  the  current  time  and  Seen  is  the 
total  range  of  the  second  guidance  phase.  In  this  research,  Seen  is 
set  as  about  one-tenth  of  the  total  reentry  range. 

The  onboard  reference  trajectory  generation  is  executed  several 
seconds  before  phase  II  by  a  Gauss  pseudospectral  method  which 
is  presented  by  the  author  in  Ref.  [16], 

Dukman’s  tracking  law  using  LQR  is  employed  for  trajectory 
tracking  in  the  phase  II.  The  dimensionless  equations  of  motion  are 
linearized  at  the  reference  profiles  to  get  the  linear  time-varying 
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Table  2 

Reentry  interface  of  nominal  reentry  condition. 

Velocity  (m/s)  Altitude  (km)  Flight  path  angle  (deg)  Longitude  (deg)  Latitude  (deg)  Velocity  azimuth  angle  (deg) 

7200  100  -2  160  5/15/25/50  55/55/52/62 


Table  3 

Parameters  of  BELBIC. 

Controller  Design  variable  REW  Si  Learning  rate 

BEL1  Aa  kai  =  10,  ka2  =  8  ka3  =  4,  k„t  =  6,  ka5  =  1  aa  =4  x  W~4,a0  =  5  x  10“5 

BEL2  Ao-W  k„,  =  10,  k„2  =  10  k^  =  3,ka4  =  5,  =  1  ua  =3  x  10-4,a„  =  5  x  10“5 


Table  4 

Results  in  nominal  condition  (Ts  =  1  s). 

Location  error  with  respect  to  endpoint  (km)  Time  parameters  (s) 

Downrange  Crossrange  Altitude  TP  TA  TC 

easel  1.23  2.740  0.13  0.15  36.77  4.98 

case2  2.824  1.737  0.72  0.15  45.9  5.51 

case3  0.898  -0.341  0.35  0.21  53.1  4.66 

case4  3.593  -0.529  0.53  0.36  50.2  4.68 


dynamics.  The  control  variable  for  trajectory  tracking  is  SU  and  we 

U  =  U„;  +  JU,[^  +  ^]  06) 

Where  oye/  and  are/  are  bank  angle  and  AOA  of  reference  trajec¬ 
tory. 

The  general  description  of  the  LQR  and  corresponding  tracking 
law  will  not  listed  here  and  can  be  found  in  [3], 

6.  Performance  of  the  proposed  guidance  algorithm 

To  evaluate  the  performance  of  the  proposed  reentry  guidance 
algorithm,  detailed  numerical  simulations  are  carried  out  with  the 
following  four  conditions:  1)  nominal  condition  in  different  reen¬ 
try  interface;  2)  perturbation  condition  considering  the  dispersion 
reentry  interface;  3)  perturbation  condition  considering  the  distur¬ 
bance  of  aerodynamic  coefficients,  air  density,  mass  of  vehicle  and 
combination  of  them;  4)  maneuvering  endpoint  position  condition. 

6.1.  Assumptions  and  design  parameters  for  simulation 

The  assumptions  and  main  design  parameters  used  for  verifica¬ 
tion  of  the  algorithm  are  as  follows: 

A.  The  trajectory  prediction  adopts  the  dimensionless  3DOF 
equations  of  motion  (A.5).  Then  the  4-th  Runge-Kutta  integral 
method  is  used  for  numerical  integration.  The  simulation  is  exe¬ 
cuted  in  the  software  environment  of  MATLAB. 

B.  According  to  the  principle  of  BELBIC,  only  one  trajectory  pre¬ 
diction  is  implemented  in  one  guidance  circle  which  is  taken  as 
1  s  or  2  s. 

C.  The  allowable  terminal  error  in  range  and  altitude  is  <10  km 
and  <2  km  respectively.  The  range  error  for  way-points  arriving  is 
<10  km. 

D.  The  predefined  parameters  of  AOA  profile  are;  am  =  20  deg, 
aN2  —  10  deg,  V\  =  4762  m/s  (corresponding  to  ui),  V2  = 
3067  m/s  (corresponding  to  u2 ).  And  the  limitation  of  the  regu¬ 
lation  magnitude  of  a  in  guidance  is  Aa  <  5  deg. 

E.  The  parameters  of  crossrange  error  corridors  shown  in 
Eq.  (11)  are  =  1.5  deg,  tp2  =  0.8  deg,  (p2  =  0.2  deg,  V3  = 
7000  m/s  (corresponding  to  S3).  V4  =  3000  m/s  (corresponding 
to  U4),  V5  =  750  m/s  (corresponding  to  U5). 

F.  The  boundary  of  the  bank  angle  is  —80  deg  <  a  <  80  deg. 


G.  Path  constraints:  heat  rate  limit  =  1000  kW/m2,  g-load 
limit  =  2,  dynamic  pressure  limit  =120  kPa. 

H.  The  aerodynamic  model  is  constructed  by  that  of  U.S.  Air 
force  concept  vehicle  of  Common  Aero  Vehicle  [?]. 

I.  The  CPU  time  of  the  guidance  cycle,  the  maximum  predictor- 
corrector  time  in  all  guidance  cycles,  the  total  prediction  time,  and 
the  onboard  trajectory  generation  time  is  denoted  as  Ts,  TP,  TA  and 
TC  respectively  in  the  following  simulation  results. 

6.2.  Performance  in  nominal  condition 

Four  different  cases  of  reentry  conditions  are  considered,  as 
given  in  Table  2,  in  nominal  condition  simulation.  And  the  same 
endpoint  position  is  used  in  the  four  cases.  The  endpoint  longi¬ 
tude,  latitude  and  height  is  258°,  38°  and  20  km  respectively. 

The  control  parameters  of  BELBIC,  including  reinforcing  signal 
REW,  sensory  input  S,  and  learning  rate,  are  all  listed  in  Table  3. 
From  the  simulation  of  guidance  performance  we  know  that  the 
learning  rate  is  the  most  influential  parameter  of  them.  It  also  in¬ 
dicates  that  too  large  learning  rate  will  lead  to  shaking  in  design 
variables  Aa  and  Act  1+1  whereas  too  small  one  will  result  in  re¬ 
duction  of  guidance  accuracy.  The  parameters  in  Table  2  obtained 
from  several  simulation  tests  are  suitable  for  the  proposed  guid¬ 
ance  problem  and  also  applied  in  the  rest  numerical  simulations. 

The  summaries  of  simulation  results  for  the  four  cases  are  given 
in  Table  4  and  Fig.  9.  These  results  show  that  the  guidance  al¬ 
gorithm  achieves  the  terminal  conditions  with  specified  accuracy, 
while  simultaneously  satisfying  the  path  constraints.  And  the  first 
two  figures  of  Fig.  9  show  that  the  concept  of  the  proposed  guid¬ 
ance  is  effective.  The  time  properties  of  guidance  algorithm  are 
also  given  in  Table  4.  In  the  first  guidance  phase,  the  maximum 
predict  time  between  way-points  is  less  than  half  of  1  s  while  the 
guidance  circle  is  set  as  1  s.  It  indicates  that  the  prediction  time 
is  less  than  the  guidance  circle  in  the  numerical  simulation.  In  the 
second  guidance  phase,  the  trajectory  onboard  generation  time  is 
within  several  seconds.  This  guidance  algorithm  is  implemented  in 
MATLAB  software.  So  it  is  potential  to  reduce  computational  time 
by  using  some  highly  effective  language  like  C++. 

6.3.  Performance  under  dispersion  reentry  interface 

To  assess  the  performance  of  the  guidance  algorithm  under 
conditions  of  dispersed  reentry  interface,  simulations  are  carried 
out  with  assumed  dispersions  on  the  reentry  initial  states,  as  given 
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in  Table  5.  The  corresponding  states  and  steering  profiles  are  given 
in  Fig.  10.  These  results  show  that  the  bank  angle  and  AOA  are 
modulated  to  meet  the  terminal  conditions.  The  time  parameters 
are  also  listed  in  Table  5  and  are  similar  with  the  simulation  re¬ 
sults  in  the  normal  condition  in  quality.  It  is  seen  that  the  influ¬ 
ence  of  interface  disturbance  to  prediction  time  is  not  obvious. 

6.4.  Performance  under  disturbed  flight  environment 

The  robustness  of  the  proposed  guidance  algorithm  is  also  vali¬ 
dated  by  the  simulation  under  off-normal  environment  conditions 
considering  the  disturbance  of  aerodynamic  coefficients,  air  den¬ 
sity,  mass  of  vehicle  and  combination  of  them.  Table  6  gives  the 
details  of  the  off-normal  conditions  and  the  summaries  of  the  sim¬ 
ulation  results.  The  corresponding  states  and  steering  profiles  are 
given  in  Fig.  11.  It  is  found  that  the  presented  algorithm  achieves 
the  same  level  of  accuracy  in  the  off-nominal  environment  com¬ 
pared  to  the  simulations  in  the  nominal  conditions.  Furthermore, 
it  seems  that  the  uncertainty  of  aerodynamic  coefficient  exercise 
more  influence  on  the  guidance  accuracy  than  the  disturbance  of 
the  air  density  and  the  vehicle  mass. 

6.5.  Performance  for  maneuvering  endpoint  condition 

The  proposed  guidance  is  designed  to  deal  with  the  situation 
that  the  endpoint  of  reentry  phase  deviates  from  the  original  posi¬ 
tion  in  the  range  of  100  km  before  the  second  guidance  phase. 
When  the  deviation  range  is  larger,  this  guidance  problem  can 
be  settled  by  increasing  Seen  in  Eq.  (15).  And  the  onboard  trajec¬ 
tory  generation  algorithm  will  also  be  suitable  when  Seen  becomes 
longer.  This  aspect  of  robustness  of  this  guidance  is  benefit  from 
the  trajectory  onboard  generation  strategy  in  the  second  guidance 
phase.  Three  cases  of  maneuvering  endpoint  conditions  and  simu¬ 
lation  results  in  guidance  accuracy  and  time  properties  are  given 
in  Table  7.  The  corresponding  trajectory  and  steering  angle  profiles 
are  given  in  Fig.  12.  These  results  show  that  a  and  a  are  suitably 
modulated  to  meet  the  terminal  conditions  with  the  specify  accu¬ 
racy  in  the  maneuvering  endpoint  position  condition.  Furthermore, 
the  trajectory  generation  time  is  also  about  several  seconds,  which 
is  the  same  magnitude  of  time  as  the  above  simulation  cases. 

7.  Conclusion 

This  paper  has  presented  an  adaptive  predictor-corrector  reen¬ 
try  guidance  algorithm  for  atmospheric  reentry  vehicles  with  mid¬ 
dle  to  high  lift-to-drag  ratio.  The  performance  of  simulations  in 
nominal  reentry  condition  validate  the  efficiency  of  the  guidance 
strategy  which  executes  a  predictor-corrector  algorithm  between 
self-defined  way-points  and  a  trajectory  onboard  generation  and 
tracking  law  in  two  guidance  phases  in  the  sequence.  The  ro¬ 
bustness  of  the  algorithm  is  evaluated  by  simulations  considering 
dispersions  on  reentry  interface,  environment  and  maneuvering 
endpoint  position  condition  respectively. 

Different  kinds  of  perturbation,  including  varied  reentry  inter¬ 
face,  environment  disturbance  and  maneuvering  endpoint  distance, 
are  considered.  It  is  seen  that  the  disturbance  on  aerodynamic  lift 
and  drag  exercise  the  most  influence  on  guidance  accuracy.  Also,  it 
is  seen  that  the  trajectory  onboard  generation  and  tracking  law  do 
much  benefits  on  improving  guidance  accuracy  on  the  condition 
of  maneuvering  endpoint  position.  Furthermore,  the  implementa¬ 
tion  of  the  predictor-corrector  algorithm  between  way-point,  not 
from  the  reentry  interface  to  the  endpoint  like  the  general  pre¬ 
dictor-corrector  algorithm,  increases  the  efficiency  of  the  guidance 
algorithm.  It  results  in  much  less  time  of  the  predictor-corrector 
than  that  of  the  guidance  circle. 
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Table  5 

Results  in  disturbance  of  reentry  point  condition  (Ts  =  1  s). 


Velocity  -  30  m/s 
0  +  2  deg 
<p  +  2  deg 
y  -  0.2  deg 
ijr  +  2  deg 


Location  error  with  respect  to  endpoint  (km) 
Downrange  Crossrange 


1.61 

1.85 


4.13 

2.11 

1.52 


Altitude 

0.113 

0.011 

0.548 

1.482 

0.213 


Time  parameters(s) 

TP  m 

0.17  67.0 

0.24  82.9 

0.18  52.26 

0.17  49.21 

0.21  77.92 

0.18  64.6 


TG 

4.37 

4.74 

6.06 

5.61 

4.18 

5.89 


Table  6 

Results  in  disturbance  of  flight  environment. 

Dispersion  case  Location  error  with  respect  to  endpoint  (km)  Time  parameters  (s) 

Downrange  Crossrange  Altitude  TP  TA  TG 


CD  -  10%  0.497 

CD  + 10%  2.30 

Cl  - 10%  2.29 

Ct  +  10%  0.659 

m  +  5%  2.74 

m  —  5%  2.19 

p  +  25%  2.40 

p  -  25%  2.09 

Cl,  CD  -  10%  p  -  25%,  m  -  5%  1.53 

Cl,  Cd  +  10%  p  +  25%,  m  +  5%  1 .91 


-8.103 

-6.57 

-2.57 

-7.168 

-2.08 

-2.68 

-3.37 

1.79 

4.90 

-1.98 


-0.2  92.48  3.72 

0.16  81.50  4.77 

0.36  89.59  5.19 

0.43  92.1  5.08 

0.22  62.13  4.99 

0.34  67.88  4.33 

0.25  82.16  4.0 

0.40  93.45  4.16 

0.34  92.77  4.56 

0.24  82.57  4.22 


Results  of  maneuvering  endpoint  condition. 

Endpoint  case  Deviation  of  Location  error  witjpresjEct  jp  endpoint  (km)  Time  parameters  (s)  _ 

endpoint  (km)  Downrange  Crossrange  Ts  TA  TG 

T1  69.0  2.24  -1.81  1  67.0  4.37 

T2  68.8  1.28  -1.46  1  82.9  6.75 

T3  92.9  2.21  -3.66  2  52.26  5.42 


The  next  step  is  to  demonstrate  how  efficiently  this  algorithm 
can  be  coded  and  how  effective  it  is  when  it  is  used  in  the  6-DOF 
flight  simulation  including  Monte  Carlo  simulation. 
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sin  cp  =  Gjj  coscp  cos  9  +  G32  cos  <psin9  +  G33  sin  <p 


(A.3) 
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Appendix  A.  Derivation  for  equations  of  motion  in  transferred 
frame 

According  to  Eq.  (6),  we  can  obtain 
cos  <p  cos  9  =  Gn  cos  tp  cos0  +  G12  costp  sin  6  +  G13  sin  cp 
cos  cp  sin  9  =  G21  cos  <pcos9  +  G22  cos  <p  sin  6  +  G23  sin  <p 
sin^S  =  G31  cos^o  cos  6  +  G32  cos  cp  sin  0  +  G33  sin  <p  (A.l ) 

And  let  two  sides  of  Eq.  (6)  multiply  the  inverse  matrix  of  G, 
we  can  get 

Gn  G12  G13  l-1  r?cos<pcos0 1  T r cos ^ cos 6>  1 

G21  G22  G23  rcos^sin?  =  rcosipsine  (A.2) 

G31  C32  G33J  |_  rsinyp  J  |_  rsirup  J 


=  B3(9,v) 

cos  (p  cos0  =  G'n  cos  <p  cos  6  +  G'u  cos  sin  0  +  G'13  sin^S 
=  B,(e,v) 

cos  cp  sin  9  =  G'2\  cos  cp  cos  9  +  G22  cos  tp  sin  9  +  G23  sin  cp 

=  B2(9,  <p)  (A.4) 

Where  B\,  B2,  63  are  the  temporary  variables  in  derivation.  So  the 
trigonometric  function  of  the  longitude  0  and  latitude  (p  of  the 
reentry  vehicle  can  be  expressed  with  B\,  B2,  B3.  The  unpowered 
reentry  dynamics  in  transferred  spherical  coordinate  can  be  de¬ 
rived  with  Eqs.  (1),  (7),  (A.4)  and  the  dimensionless  equations  of 
motion  in  original  sphere  coordinate  listed  in  [17],  given  as 

dz  „  .  ~ 

—  =  u  sin  / 
ax 

dxp  u  cos  / 

dx  ZCOS(p^B\  + 

•  [-G31  (B3B1  cos(A0  +  \jr)  +  B2  sin(A0  +  &)) 

+  G32(B  1  sin(A0  +  f)  -  B3B2  cos (A0  +  \jr)) 


Denoting  that 


+  G33  (B3  +  B2 )  cos(Aq  +  l/r)] 
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